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ABSTRACT 

A Midcourse guidance and navigation system for continuous low 
thrust vehicles is developed in this research. The vehicle is requir- 
ed to reach an allowable region near the desired geosynchronous orbit 
from a near earth orbit in minimum time. The angular position of the 
vehicle in the orbit- is assumed to be unimportant during this midcourse 
flight. The magnitude of the thrust acceleration is assumed to be 
bounded. The effects of the uncertainties due to the random initial 
state, the random thrusting error and the sensor error are included. 

A set of orbit elements, known as the equinoctial elements, are 
selected as the state variables. The uncertainties are modelled sta- 
tistically by random vector and stochastic processes. The motion of 
the vehicle and the measurements are described by nonlinear stochastic 
differential and difference equations respectively. 

A minimiim time nominal trajectory is defined and the equation of 
motion and the measurement equation are linearized about this nominal 
trajectory. An exponential cost criterion is constructed and a linear 
feedback guidance law is derived to control the thrusting direction 
of the engine. Using this guidance law, the vehicle will fly in a 
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tirajGctory nGx^hboring the noitiiria.X trajcctoiry, Th© extended. Kalman 
filter is used for state estimation. 

Finally a short mission usin^ this system is simulated. The re^ 
suits indicated that this system is very efficient for short missions 
For longer missions some more accurate ground based measurements and 
nominal trajectory updates must be included. 


Thesis Supervisor: John Jacob Deyst^ Jr. ^ Sc.D. 

Title: Associate Professor of Aeronautics and Astronautics/ M.I.T. 
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CHAPTER 1 


INTRODUCTION 

Recently, solar electric spacecraft propulsion systems of high 
efficiency have been developed. The advancements of this new tech- 
nology have opened the road to a new era of space exploration and 
scientific research. Many space missions utilizing this propulsion 
system have been planned by the National Aeronautics and Space 
Administration for the second half of this decade. One of these 
missions utilizes the solar electric propulsion stage (SEPS) for the 
delivery and return of scientific payloads between near earth orbits 
and the geosynchronous orbits-. 

The purpose of this research is to develop a practical and 
efficient midcourse guidance and navigation system for these continuous 
low thrust vehicles. The vehicle is required to reach an allowable 
region near the desired geosynchronous orbit in a minimum amount of 
time. During this midcourse phase the angular position of the vehicle 
in the orbit is assumed to be unimportant. The magnitude of the thrust 
acceleration of the SEPS is constrainted to be bounded. The uncer- 
tainties due to the random initial state, the random thrusting error 
and sensor error are included- . 

In Chapter II a set of state variables is selected and a 
mathematical model is constructed. The motion of the vehicle is 
described by a nonlinear stochastic differential equation and uncer- 
tainties are modelled by stochastic processes. In Chapter III a 
minimum time nominal trajectory is defined and the equation of motion 
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and measurement equation are linearized about this nominal trajectory- 
A meaningful cost criterion is constructed and a linear feedback con- 
trol law is derived for the guidance system. In Chapter IV a naviga- 
tion system is constructed and the complete closed-loop system is 
discussed* The computer simulation results of this system are 
presented and discussed in Chapter V. Finally conclusions are 
presented in Chapter VI and the various equations related to the state 
variables are presented in the Appendix* 
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CHAPTER II 


THE MATHEMATICAL MODEL 


The construction of a mathematical model is the most important 
step in the design of a gudiance and navigation system for continuous 
low thrust vehicles. In this chapter an appropriate set of state 
variables is selected. Then the equations describing the motion of 
the vehicle and the dynamics of the sensors are chosen. The uncertain- 
ties due to the random initial state, the random thrusting error and 
the sensor error are modelled statistically. Finally the problem 
considered in this research is stated mathematically." 


2 .A State Variables 


The state variables used in this research are the equinoctial 
elements [4] . The most important advantage of these elements is 
that their equation of motion are free from singularities for zero 
eccentricity and zero inclination. This is not the case for the 
classical orbit elements [2] . 

The equinoctial elements can be defined in terms of the 
classical orbit elements as follows 


a 


a 

h 


e sin(oj+f2) 

k 


e cos(ui+fJ) 

^0 


Mq+(o+S^ 

P 


tan (i) sin Q 

_ q _ 


tan ( j) cos Q 


(2.A.1) 
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where a, e, i, , w and are the classical orbit elements 
a = semimajor axis 
e = eccentricity 
i = inclination 
Mq= mean anomaly at the epoch 
0 ) = argument of perigee 
n = longtitude of the ascending node 


Alternatively/ the equinoctial elements can be defined in terms 
of the post it ion and velocity vectors. A coordinate system is defined 
for this purpose as shown in Figure 2.1. The unit vector normal to 

the orbital plane is given by 
r X V 


where r and v are the position and velocity vectors respectively. 

The components of this vector can be written in terms of the classical 


orbit elements as 

w = 0 

sin Q sin i 
-cos U sin i 

cos i 

where is the rotation matrix 



{2. A. 3) 


cos ^ sin Q 0 
sin. cos ^ 0 

0 0 1 


1 

0 

0 


0 


0 

cos 

i 

sin i 

sin 

i 

cos i 


cos ^ sin 0 
-siti Q cos Q 0 
0 0 1 


(2. A. 4) 
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Equinoctial Coordinate Frame 
Figure 2*1 
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Using (2.Ao3) in (2,A,1) the equinoctial elements p and q can be 
written in terms of these components 


^ 1 + 0), 


- 


q = 


1 + 


(2.A*5) 

(2.A.6) 


The unit vectors f_ and defined in Figure 2.1 can now be written 
in terms of p and q 


f - R- tl 0 0]^ 


1 + 


1 2^2 

1 - p + q 

2 p q 

L-2 P 


(2.A.7) 


a = r 0 1.0] 


2 2 

1 + P + q 


2 p q 
1 + 

Li q 


1 + p2 - q2 


(2, A. 8) 


The Gleinents h and k are seen to be the components of the eccentricity 
vector in the directions of these unit vectors and are given by 


u T 
h - e a 

T 

k = e f 


where e is the eccentricity vector 


(r X v) XV 


W 


(2. A. 9) 
(2. A. 10) 


(2. A. 11) 
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The element a is given by 


a = ( 


1^1 




(2.A,12) 


If the components of the position and velocity vectors along the unit 
vecotrs f and g are denoted by - . 


== • £ £ 

g 

= - i. 


Xi = V-" f 


Yl = V g 

the eccentric longtitude F can be written as 


cos P - k + 


- h k 3Y^ 


(2. A. 13) 
(2.A.14) 
(2.A.15) 
(2,A.16) 

(2.A.17)- 


(l-h^e)Yj^. - h k 

sin F = h + 




(2. A. 18) 


where 


6 = 


(2 .A. 19) 


1 + /1-h^-k^ 


The remaining element Xp. is given by Kepler's equation 


X = p - K sin F + h cos F j t 

U f 


(2,A,20) 


where t is the time measured from the epoch. 
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These equations are the transformations from classical orbit 
elements or position and velocity vectors to equinoctial elements* 

The inverse transformation from equinoctial elements to position 
and velocity is also included here for convenience* 

To calculate the position and velocity vectors from equinoctial 
elements, Kepler’s equation {2. A. 20) must be solved for the eccentri- 
city longtitude F* Then the position and velocity vectors are given 
by 

r = 1 g 

V = f + g 

a[l-h^3)cos F + h k 6 sin P - k] (2*A.23)^ 

all-k^3) sin F + h k B cos F - h] (2*A.24) 

[h k p oosF- (1-h^e) sinF] (2. A, 25) 

I (1-k^e) cos P - h k 0 sinFl (2. A. 26) 

where 

r = a[l-k cos F - h sinF] (2. A. 27) 

2.B Equation of Motion 

The only forces assumed to be acting on the vehicle are the 
inverse square gravitational attraction of earth, the desired engine 
thrust and the random thrusting error. The motion of the vehicle is 
described by a nonlinear stochastic differential equation [10] - 

^ = G(x,t)u + G(x,t)n (2.B.1) 
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where u is the desired engine thrust, n is the random thrusting error 
and G(x,t) is a 6x3 matrix of the partial derivatives of the equi- 
noctial elements with respect to the velocity vector. The G(x,t) 


matrix is given by 
Sx 

G/x,t) = ^ 


(2.B.2) 


where 


8a 2a T 


(2.B.3) 


a-h -k r / 0 1 ^ . y 1 




k(qY^ - pXj^) 


(2.B.4) 




h(qY^ “ T 


mar\f l-h^'-k" 


^^0 2 3 T /l-h^-k^ 

J Z t J +y — Sji P[ (h 

— ma v 

3x ay 3Y 

+ k-^ f_+ (h ^ + k ^ )5l 


(2.B.5) 


(qY^-px^) ^ 

■ ■ ' — ' w 

2 -12 « 2 
ma /1-h -k 


(2.B.6) 


23 



(2.B.7) 



, 2 2 
2ma^/l-h^-k^ 


is - 1+P^+q^ 

3v , 5 — y 

2iua^/l-"h^-k'^ 


T 


w 




2.C Measurement: Equation 

Sensors are used to make measurements and update the vehicle's 
estimate of it's state- These measurements which are corrupted by 
random sensor errors are assumed to be made at discrete instants of 
time. The types and the schedule of these measurements are assumed 
to be fixed. The measurement equation is given by 

2 (t^) = h(x, t^) + ^(t^) (2.C.1) 


0 = t. <t^<. . . <t “ t^ 

1 z m r 


where is the measurement vector, h(x,t^) is a vector function 

of the state and }^(t^) is the vector of the random sensor error. 
The form of the vector function h(x,tj^) depends on the type of 
measurement. For example, if a earth-diameter and a star-elevation 
measurement are taken simultaneously, the vector function h(^t^} 
given by 


h(x,t^) 


2 sir.-'- (jf) 
cos"^ 


(2.C.2) 
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where £ is the unit vector from the vehicle to the star and d 
is the diameter of earth* These measurements are pictured in 
Figure 2,2. 


2,D Statistical Modelling of the Uncertainties 

There are three sources of uncertainties considered. They are 
the random initial state ^ the random thrusting error and the sensor 
error. The initial state x(0) is assumed to be a Gaussian random 
vector. The mean and covariance of this vector is denoted by 


E [x(0) ] = X 


E{[x(0) - x(0)][x(0)-5(0)l'^}= M(0) 


( 2 . 0 . 2 ) 


If the covariance matrix of the initial state is given in terms 
of the position and velocity vectors, the necessc^ry transformation 


to the equinoctial elements is given by 


M(0) 



T 

ic(0) 


where M* (0) is the covariance matrix of the initial position and 
velocity vectors. The matrix 3x/9r is included in the Appendix. 

The random thrusting error is modelled by a zero mean white 
Gaussian random process 

E[n(t)]=:0 (2.D.4) 

E In(t)n'^(T) ] =N 5(t-T) {2.D.5) 

The matrix N, representing the strength of the process noise, is 
dependent on the desired engine thrust u. Both the n and u vectors are 
pictured in Figure 2.3. The z* axis is defined in the direction 
of the vector u. The x’ and y* axes are defined in a plane normal 
to u to form a triad. The quantities n^, and n^ are assumed to 
be zero mean independent random processes 
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i=l,2,3 


(2.D.6) 

(2.D,7) 


E[nj^(t)] = 0 

E[n^(t) nT(T)] 


i=l,2,3 


= 6(t— t) 


E[n^(t) nj(x)] = 0 (2.D,8) 

These quantities are also assumed to be independent of the vector 
u. Let R 2 orthogonal transformation such that 


= R_[ 0 0 1]’’ (2.D.9) 

(Ui 2 


Then the vector n(t) and it*s correlation can be written as 


n = |u| 152^^1 ^2 ^^3^ 

T 


(2.D, 

10) 




V , v”l 


( 

nj^(t)nj^(x) 

(t)n2 (t) 

nj^(t)n2(x) 

) 

E[n(t)n^(T) ] = E <|u|^R 2 

n2(t)nj^(x) 

n 2 (t)n 2 (x) 

np (t) n^ (x) 

2 ( 

( 

n^ (t) nj^ (x) 

n^ (t)n 2 (x) 

n^ (t)nj (x) 



{2.D*11) 

In view of (2.D,7) and (2,D.8), the correlation of n becomes 


E tn (t) n^(T) ] 




0 

0 


0 


0 



6 (t--T) 


(2.D.12) 


Furthermore since and H 2 are defined in a plane normal to it 
is reasonable to assume that 

= N 2 (2.D,13) 
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Using (2,D,5), (2,D,12). and (2.D,13) the matrix W is given by 

N = N^H-u u (2.D,14) 

The last source of uncertainties is the additive random sensor error 
\^(t^) in (2-C,D* This random sensor error is modelled as a zero 
mean white Gaussian random sequence 


E[V^(ti)] = 0 

(2.D.15) 


(2.D.16) 


Finally, the initial state x(0) , the thrusting error n(t) and the 
sensor error v (t.) are assumed to be independent of each other# 

—Td 1 

2#E Statement of the problem 

Given the nonlinear stochastic system in (2#B#1) and (2,C#1), the 
problem is to determine the engine thrust u(t) , t£t<t^ subject to the 
bounded magnitude constraint 


|u(t)j £ Uj^(t) 0<t<t^ 


(2#E#1) 


such that the vehicle will reach an allowable orbit near the desired 
geosynchronous orbit in a minimum amount of time# The function 
u^(t) in (2.E#1) represents the maximum amount of thrust acceleration 
that the SEPS can deliver at time t# The desired geosynchronous orbit 
is defined by the vector x^ where ^ is free. The quantity (x^) ^ 

is free because the angular position of the vehicle in the orbit is 
assumed to be unimportant during the midcourse phase. The allowable 
orbit near the desired geosynchronous orbit is defined by the target 
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where represents the maximum allowable deviations, 

mathematical modelling of the problem is now completed, 
systems it cannot be assured that the constraints (2.E 
are satisfied. Probability measures are introduced in 
chapter to overcome this difficulty. 


The 

For stochastic 
1) and (2.E.2) 
the next 
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CHAPTER III 


THE GUIDANCE SYSTEM 


The problem formulated in the last chapter is a nonlinear sto- 
chastic optium control problem. This class of problems in general has 
no known solutions. In this chapter approximations are introduced so 
that a practical solution of the problem can be found. First a min- 
imum time nominal trajectory is defined. This nominal trajectory is 
the solution to the problem if the uncertainties are absent- Then 
the nonlinear stochastic system (2 . B :i) and^ ( 2 .C . 1) is linearized 
about this nominal trajectory. The linearized equation of motion is 
also discretized for convenience. An exponential cost criterion is 
formulated for the discretized linear stochastic system so that the 
vehicle will reach the allowable region near the desired geosynchronous 
orbit with the magnitude of the control bounded. Finally the solution 
to the linear-exponential-gaussian (LEG) terminal cost problem is pre- 
sented and a linear feed-back control law is obtained for the guidance 
system. 


% 

3. A Nominal Trajectory 

Since the objective of the problem is to guide the vehicle so 
that it will reach the target set in a minimum amount of time, the 
natural choice of the nominal trajectory is the minimum time traject- 
ory. The state equation of this trajectory is given by 


dx_ 

-^= G(XQ,t)UQ 


(3.A.1) 
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where ^ is the nominal state and is the nominal control. The 
initial and the final conditions are 

3^ (0) = X (0) (3. A, 2) 

= x^ (3. A. 3) 


where ) 4 is free. The nominal control constraint is 

I 1 (3. A. 4) 

The cost criterion to be minimized is 


J 


0 



(3. A. 5) 


The solution of this problem will fix the nominal and t^. 

This problem may be solved by various existing techniques such as the 
minimum principle of Pontryagin or differential dynamic programming. 
Note that the nominal control u (t) will in general stay on the con- 
straint boundary for this minimvim time control problem. 


3.B Linearization 

The equation of motion and the measurement equation may now be 
linearized about the nominal trajectory. Define fix and fiu as the de- 
viations of the state and the control respectively from the nominal 
values 


fix = X 
fiu = u 




^0 


(3.B.1) 

(3.B.2) 
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A linear expansion of the equation of motion yields 


dx 

dt 


= G(x^,t)u + t~ G{x,t)u] 6x + G(x,t)u] 6u 






+ G (xq'^^ 2- 


(3.B.3) 


Using (3.B.1) and (3.B.2) this equation may be rewritten as 


dx 


af = A(Xf^,Ufj,t)x + B(3^,t)u + B(x^,t) n 


v-Q'ito 


-A(Xq,Uo t) x^ 


(3,B,4) 


where 


A(Xo,Uo.t) = 


B(j^,t) = G(^,t) 


(3.B.5) 

(3.B.6) 


The 6x6 matrix A(x^,i^,t) can be calculated explicitly in terms of 
the equinoctial elements. This matrix is included in the Appendix. 

The process noise n in (3.B.4) still depends on the desired control u. 
Another approximation is made here so that n is approximated by a zero 
mean white gaussian random process i^. The statistics of this process 
is given by 


E[no(t)] = 0 


Etn_Q(t)^(T)] = Nq d(t-T) 

Nq = N^[I-u^jU^'^] + N3 ^ Uq"^ 


(3.B.7) 
(3.B. 8) 
(3.B.9) 
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th 0 linearized equation of motion becomes 


af = B(XQ,t)u + B( 5 ^,t)llQ 


-A(XQ,^,t) Xq 


(3.B.10) 


Similarily, a linear expansion of the measurement equation (2.C.1) 
yields 


z(t^) = h(5^,t^) + + :i^(tj,) 


(3.B.11) 


Using (3.B.1) the linearized measurement equation becomes 


z(t.) = H(XQ,t^)x(t^) + 5 ^(t^) + h(Xo.t^) - H(xQ,t^)xQ(t^> 


(3.B.12) 


where 




(3,B.13) 


The matrix H(Xp,,t.) is a nonrandom matrix which depends on the type of 
— u 1 

measurement taken. For the earth-diameter and star-elevation measure- 
ments, this matrix is given by 


rV4r -c 


H(x^ti) = 


:2s^-(sTr)rT dr"^ 






L J -0 


(3.B.14) 


where ^ is a 3x6 matrix of the partial derivatives of .the position 
vector with respect to the equinoctial elements. This matrix is in- 
cluded in the Appendix. 
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3 *C Discre-tization 


It is more convienient to solve the guidance problem if the state 
is expressed as the sum of a stochastic process x and a nonrandom 
vector function b. Define x and b by the following equations 


dx 


B(x^,t)u + B{x^,t)n^ 


'dt 

A{xQ,UQ,t)x + 

(3.C.1) 

db _ 


A(io'Ho't)So 

(3.C.2) 


Then the state x.is given by 

x-x+b (3.C.3) 

If the. boundary condition on b is defined at the nominal final time 
by 

b(tf) = X ^ (3.C.4) 

then x(t^) represents the deviation at the target • The corresponding 
initial condition of b is given by 

^(0) = +J ^ $(t,0)A(3^,^,t)Xq(t) dx (3.C.5) 

where 4(x,0) is the state transition matrix satisfying the follow- 
ing equations 

X) <Kx,t) (3.C.6) 

$(t,t) I {3.C.7) 

Using {3.C.3) the initial condition for x is given by 

x(0) = x(0) - b(0) (3.C.8) 
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Therefore x(0) is also a Gaussian random vector with mean and covari 

ance given by 

E(x{0) ] = x(0) - b(0) 

E{[x(0) - x(0) +b(0)] [x(0) - x(0) + b(0)]^} =M(0) (3.C.9) 

The linearized measurement equation (3.B*12) may also be written in 
terms of x and b 

z(t^) = H(xQ,t.)x(t^) + H(x^,t^) tb(t;j^) - XQ(t.)] 

(3.C.11) 

Now (3,C.l) and (3.C-2) may be discretized* Let the time interval 
[0,t^] be partitioned into n equal subintervals 

0 =: ^ (3X.12) 


Then the discretized equations are 

^t ^ 

"j 


X(tj^j^) = 4(tj^^,tj)x(t^) B(XQ,T)u(T)dX + n^j 


-1 /*^£ 

b(tj) = ^ (t^,tj)b(t^) + ^(tj,T) A(5 ^,Uq,t)Xq 


. (t) dT 


(3.C.13) 


(3.C*14) 


where - is a zero mean white Gaussian random sequence 

-Hi] 


E [ngj] = 0 


E [nojOol] = ^Oj Sk 

•tj+1 


(3.C.15) 

(3.C.16) 




Nq(t) B (Xq/T) 


(t j^j^,T)dx 


(3.C.17) 
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If the number n of subintervals is very large, the control u(t) 
and the function can be approximated by step functions 


u(t) 

= u(t.) 


(3.C.18) 

m 



(3.C.19) 


Then the discretized equation (3.C.13) becomes 


x(t.^^) = Mt.^^,tj)x(t.) + iKt.^l,tj)u(t.) + n^j 


(3.C.20) 


where. 






4>(tj^j^,T) B(J^ ,T)dT (3.C.21) 


The control constraint equation (2,E.l) also become 

lu(tj) I < Uj^(tj) j=l,2,...n 


{3.C.22) 


3.D> Exponential Cost Criterion 

In the absence of the uncertainties , the minimum time nominal 
trajectory defined in section 3. A is the solution to the' guidance 
problem. When the vehicle is disturbed by random thrusting error, 
the trajectory of its true motion v/ill deviate from the nominal tra* 
jectory. However, there is no reason to try to drive the vehicle 
back to the nominal trajectory- Instead, the control sequence u(tj) 
is determined to take into accoxmt the uncertainties so that the 
vehicle will reach the target set at the nominal time with the 
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control sequence boxonded* For the stochastic system (3.C*11) and 
(3.C-20) it cannot be assured that these objectives can be met. 
Therefore probability measures are used to evaluate the effectiveness 
of the control in acheiving these objectives and the probability that 
the vehicle reaches the target and the controls stay within the bounds 
is to be maximized. 

^\arget 


and |u(t^) I i, 1 


(3,D.l) 


This probability can be written as an expectation if the following 
indicator functions are defined 

(1 if I X. (t-) - (X-) . |<(6x-) . 

1,5^ ,tx(t ) ] =1 ^ ^ f 1 - f 1 

(OXf)^ ti Ix^(tj) - (Xj)^[>(6x^)^ 

i » lr6; i 5^ 4 (3.Di2) 


m 


1 if lu(tj) |<U^(tj) 

0 if |u(tj> 


^ ^ li2».*/n 


(3,D.3) 


Then the probability in (3.D.1) is the expectation of the product 
of these indicator functions 


= E 




(3.D.4) 


Application of dynaimic programming to this problem will determine the 
optimal control. The character of the control is such that maximum 
thrust is utilized until the estimated state reaches the target state. 
In effect the estimated state is driven to the target as quickly as 
possible and the essential character of the minimum time solution is 
also present in the maximum probability solution. 
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Since the objective of the SEPS spacecraft to reach the 
target set in. minimum time, the control sequence u(tj) should 
satisfy the equality in (3.C.22) . There is no known general solution 
for the problem of determining the control sequence to maximize 

the expectation in (3.D*4) subject to the linear stochastic 
system (3*C*11) and (3.C-20). The product of these indicator func- 
tions will now be approximated by a exponential cost function- 


J^=E 


E l^exp |~| 






(3-D. 5) 


The weighting matrices Lj and must be chosen so that each term 
of the exponential function in (3.D-5) approximate the corresponding 
indicator function in (3.D.4), The normalized second moments of the 
indicator functions j ^ [x^(t^)l are 

2 

2T^ / tx (tJ-{x ) dx{tf). = 


i = 1,6; i ^ 4 


(3.D.6) 


The normalized second moments of the indicator functions 
are 



lu(t,)J 




ff 


<)!' d d Uy(tj) d u^(tj) 


I"™'*!”' 

5 


k = x,y,z 

j = 1,2, - . -n (3-D. 7) 


where the integration is over a sphere with radius u^(tj). Therefore 
if the weighting matrices and are chosen as 


L . 

J 




(3.D. 8) 
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1 


0 


0 


1(5 X^)^] 
0 

0 


2 


0 


[(5x^ ) 


2 0 




0 

0 

0 


0 

0 

0 


0 

0 


Qf ^ 


0 0 


0 0 0 
0 0 0 


0 

0 

0 


0 

1 


0 


0 

1 


[(6Xf)6] 


2 

_ (3.D.9) 


the noimalized second itioinents of the indicators are the same as the 
normalized second moments of the corresponding terms in the exponen“ 
tial cost function. The solution for the problem of the maximiza- 
tion of the expectation of this exponential cost criteria is pre- 
sented in the next section. 


3,E Solution of the LEG Terminal Cost Problem 

The linear discrete stochastic system obtained in the last four 
sections is given by 

j = 1,2, . . .n , (3.E.1) 

z(t^) = x(t^) + 

+ [b(t^) - 

i = 1,2,. . .in (3.E.2) 
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The initial state x(t^) is a Gaussian random vector, the process 
noise and the measurement noise zero mean white Gaus- 

sian random sequences all of which are statistically independent- 
The measurement noise covariance and the control weighting matrices 
are positive definite matrices- The process noise covariance and the 
terminal state weighting matrices are positive semi-definite matrices 
The problem of the determination of the control sequence to maximize 
the expectation of the exponential cost criteria in (3-D- 5) is 
called the linear-exponential-gaussian (LEG) terminal cost problem- 
The maximization of the expectation in (3-D- 5) is the same as the 
minimization of the following 

u (tj)Lj ^ ^f ^ 

(3-E-3) 




with 


Y = -1 


(3-E-4) 


This problem is treated in a paper by Speyer, Deyst and Jacobson 
[9]. The controls are restricted to be Borel functions of the past 
measurement history- The key in solving this problem is to utilize 
the results of the Kalman-Bucy filter [5] and dynamic programming [6] 
For the terminal cost problem formulated here, the separation theorm 
[11] holds. The optimal feedback control is a linear function of . the, 
current state estimate 


u{tj) = -A(tj) x(tj) (3.E.5) 

where x(tj) denotes the current minimum variance estimate of x(tj). 
Under the conditions of this problem, the state estimate is the 
mean of x(tj) conditioned on the past measurement history tz(tj^) , 
z (t 2 ) • * • z ( ] f t^5t j - At a measurement, this conditional mean is 
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updated by 

= x{t.“) + K(t.) X.(t.) (3.E.6) 

— J D J ^ J 

where and x(tj ) denote the estimate of x(tj) after and before 

the measurement respectively. 'The measurement residual y.{tj) is 
given by 

y_(tj) = 2(t.) - h(XQ,tj) - H(xQ,tj) Ib(tj)-XQ(tj)] 

- H(i^,tj) 5{tj) (3.E.7) 

The Kalman gain K(tj) is given by 

K(t^) =P(tj+) H’^(xQ,t^) V"^(tj) (3.E.8) 

where P(tj) is covariance matrix of the estimation error conditioned 
on the past measurement history • This conditional covariance matrix 
is updated at a measurement by 

P(tj'^) = P(t^“) - P{tj") H'^(j^,tj) lH(xQ,tj) P(t.“) H'^(^,tj) 

+ V(tj) H(^,tj) P(tj“) (3.E.9) 

where P(t.^) and P(t.^) denote P(tj) before and after the measurement 
respectively. Between two measurements, P(t^) propagate 

according to the following equations 

-^^j+l^ “ (3.E.10) 

”<S’ ^ '‘oj 

The initial state estimate and the error covariance matrix are given 

/\ 

by the apriori statistics of x(t^). While the separation theorm 
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holds for this problem, the certainty equivalence principle 13] does 


not hold. The feedback control gain depends on the noise char- 

acteristics. This dependence reflects the quality of the state est- 
imate. The feedback control gain matrix is given by 




A(tj) = [L, + 




(3.E.12) 


The matrix Q(tj) is given by a backward difference equation 


Q(t^_j^) = 3>'^(tj,tj_^) jcKt.) - Q(tj) [^'^(t.,tj_^). 


.-1 .,.T, 


Q(tj) iHtj,tj_^) + t 

$(t^,t._^) (3.E.13) 


where at a measurement 


Q(tj") = Q(tj‘^) + K(tj) [Y"^(tj) 

K(tj)]”^ K'^(tj). Q(t^) 


YK^(tj) QCtj"^) 


(3.E.14) 


Note that at a measurement., (3.E.12) becomes 


A(tJ = iLj +>'^(t^^^,tj) Q(t^+1> 'j^(tj:^j^,tjO]"^ 

>l> (tj^l^tj) Q(t^-J^) $(tj^j^,tj) 


(3.E.15) 


where Q is replaced by " 

The matrix Y(tj) is the covariance matrix of the measurement 
residual 


Y(t.) = P(t.) H^(^,t.) t V(t.) (3.E.16) 

3 -^3 3 —03 3 
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Equation (3.E.14) shows the dependance of the control gain matrix on 
the noise characteristics explicitly. The terminal condition of 
Q(tj) is given by 

Q(t^^.jL) = Qf + YQf - YQf Qf (3.E.17) 


3.F The Guidance System 

The linear feedback control law obtained in the solution of the 
LEG terminal cost problem can be used for the midcourse guidance of 
the SEPS Spacecraft. Since the overall objective of the SEPS Space- 
craft is to reach the target set in minimum time, full thrust acceler- 
ation will be used to propel the vehicle. The LEG guidance law is 
used to determine thrust direction only and full thrust magnitude is , 
always utilized. Therefore the guidance law is given by 


u* (t.) 


C3.F.1) 


where using (3.C.2) and (3.E.5) u’ (t^) is given by 


u*(tj) = -A(t,) [x(ty - b(t.)] 


(3.F.2) 


The on-board guidance system is only required to perform the vector 
subtraction and matrix multiplication in (3.F.2). The feedback 
control gain matrix A(tj) and the vector b(tj) can be computed be- 
fore the mission and stored in a computer on the SEPS for real time 
mission usage. The navigation system to estimate the state x(t^) 
is discussed in the next chapter. The guidance law (3.F.2) is 
pictured in Figure 3.1. 
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CHAPTER IV 


THE navigation SYSTEM 

In the last chapter a linear feedback cbritrol law was . obtained 
for the guidance of the SEPS Spacecraft. Using this control law, the 
vehicle will fly in a trajectory neighboring the miniitium time nominal 
trajectory. Therefore the linear Kalman filter presented in section 

3. E is not adequate to estimate the vehicle's state- In this chapter 
the extended Kalman filter [7] which is adequate for neighbouring 
trajectory estimation is discussed. This estimator, together with the 
linear feedback control law obtained in the last chapter forms the 
complete closed-loop midcourse guidance and navigation system for 
the SEPS Spacecraft . 

4. A Extended Kalman Filter 

The extended Kalman filter has the same structure as the linear 
Kalman filter. However, instead of linearizing about the minimum 
time nominal trajectory alone, the extended Kalman filter is linear- 
ized about a number of nominal trajectories,. After each measurement, 
a new estimate of the state is obtained- This new estimate is used 
to define a new nominal trajectory. Then the equation of motion and 
the measurement equation are linearized about this new nominal tra- 
jectory. 

It is more convenient to discuss the extended Kalman filter if 
the continuous equation of motion (2.B.1) is used. Now suppose the 
control u(t) , 0£t<t^ is known. Let the estimate of the state and the 
error covariance matrix of this estimate after the measurement at 
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time be x(tt) and P(t^) respectively. This estimate is used to 
define a nominal trajectory 


dx, (t) 

— dt- = 


t^ct 


(4.A.1) 


X. (t,) = a(t^) 


(4. A. 2) 


The subscribt i is used to emphasize the dependence of the nominal 
trajectory x^(t) on the state estimate x(t^) . Define <Sx^(t) and 

6x.(t) = x(t) - X. (t) t.<t ( 4 ^^ 3 ) 

(4. A. 4) 


Linearization of (2.B.1) and j(2.C.l) about this nominal trajectory 
yields 


d6x^(t) 
■ "dt “ 


= A(x^,U,t) 6x^(t) + 3(x^ft)n 




(4. A. 5) 




(4. A. 6) 


Now the linear filtering theory can be applied to estimate 6x^(t). 
Before the measurement at time the estimate 6x^{t) and the 

error covariance matrix (t) of this vector are given by the 

following equations 


d6x. (t) /s 

— ^ A(x^,u,t) 6x^(t) 


(4. A, 7) 


25 " A(x^,u,t) ^ (x^,u,t) 


+ B(x^,t)N (Xi/t) 


t . <t<t . 

1“ x+1 


(4, A. 8) 
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using (4. A. 3) this estimate is related to the estimate ^(t) of the 
state x(t) by 


Also using (4*A.2) 


6^^(t) = ^(t) - x^(t) t^<t 


6^i(tT) - 0 


and in view of (4, A, 7) 


6x. (t) = 0 t. <t<t. , . 
— JL ' ' i— J.+1 


(4. A. 9) 


(4. A. 10) 


(4. A. 11) 


Therefore before the measurement at time estimate of- the 

state is given by the nominal trajectory x^(t) 


x(t) = x^tt) 

= G(x,t) u(t) 




(4. A. 12) 


(4. A. 13) 


6Xi(ti;i)} 


At the measurement at time ^6x, are updated by the 

following equations 

(4*A,14) 

(4. A. 15) 

^ ^ (4. A, 16) 




— 0 . 
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using (4.A.4) , (4. A. 9), (4. A. 11) and (4. A. 12), (4. A. 14) becomes 


x(t.+i) = x(t.;^) + K. (t.^^) {z(t.^^) - 

(4. A. 17) 

Using (4. A. 3) the error covariance matrix (t) of the estimate of 

6x^(t) and the error covariance matrix of the estimate of x(t) 

are the same 
dP^(t) 


= A(x,u,t) P^(t) + P^(t) A^(x,u,t) + B(x,t)N BMx,t) 

(4. A. 18) 


(4.A.19) 


Hence (4. A. 17) can be rewritten as 


^tt.+j) = ict.;^) + - hixctjj^) ,t.^^n 

(4. A. 20) 


where now the Kalman gain Kj^ given by 

Ki^'^i+l) = ^<^i+l> H’^tx(ti;^),t.^^] V-l(t.^^) {4.A.2D 


Now the new estimate used to define a new nominal 

trajectory similar to (4,A.l) and (4-A. 2) and the preceding method 
can be repeated. The result is the extended Kalman filter given by 
(4. A. 13), (4. A. 18) to (4-A-21) • This estimator is pictured in 

Figure 4*1. 
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4,B The CUQsed-loop Guidance and Navigation System 

The linear feedback control law in Chapter 3 and the extended 
Kalman filter in the last section forms the complete closed-loop 
midcourse guidance and navigation system for the SEPS Spacecraft. 

The on-board guidance system consists of the linear feedback control 
law (3.F.1) and (3.F.2) where A(tj) and b(t^) are precomputable 
quantities. Note that A(t^) is computed by using the equations in 
Chapter 3 where the quantities P(t^) and K(tj) are not the same as 
the quantities P^(t) and K^<t) in the last section. The quantities 
P(tj) and K(tj) are computed along the minimum time nominal traject- 
ory while the quantities ^^(t) and along a number of nominal 

trajectories. This control law will guide the vehicle to fly along 
a trajectory neighbouring to the minimum time nominal trajectory 
and reach the target set at the nominal final time t^. The thrust 
acceleration is always fully utilized to propel the vehicle and the 
control is always on the constraint boundary for this minimum time 
mission. The on-board navigation system consists of the extended 
Kalman filter (4. A. 13) and (4.A.18) to (4. A. 21) where all the quanti- 
ties must be computed on-board the vehicle. The on-board computa- 
tion of these quantities is the most important disadvantage of this 
navigation system. The closed-loop system is pictured in Figure 4.2, 
Although this guidance and navigation system is designed for the raid- 
course phase , it can also be used for the terminal phase by including 
the term for the angular position of the vehicle in the terminal 
state weighting matrix. However, in this case the objective of 
reaching the target set which now included the angular position of 
the vehicle is more difficult to meet than the midcourse case, unless 
the nominal mission time is very short. 
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CHAPTER V 


SIMULATION RESULTS AND DISCUSSION 

A computer program has been prepared to simulate this midcourse 
guidance and navigation system in real time. Although the system 
was originally designed for missions from near earth orbits to geo- 
synchronous orbits, the simulation of a shorter mission should 
equally well reveal the character and performance of the system. 

The simulation results of this short mission, together with a dis- 
cussion are presented in this chapter. 

5. A Simulation Results 

The minimum time deterministic control problem which generates 
the minimum time nominal trajectory defined in Section 3. A can only 
be solved by numerical methods. For the simulation in this research 
an approximate minimum time nominal trajectory is used- For the de- 
tails of this approximate minimum time trajectory^ the reader is 
referred to Shepperd 17]. Flying along this nominal trajectory the 
SEPS Spacecraft would reach the desired geosynchronous orbit from a 
near earth orbit- If the near earth orbit has a radius of 4300 miles 
and an inclination of 28 degrees, and if the desired geosynchronous 
orbit has a radius of 2600 miles and an inclination of 0 degrees , the 
nominal final time of this mission would be approximately 150 hours. 
In the results presented here only the first 22-64 hours of the mis- 
sion are simulated. This nominal trajectory is pictured in Figures. 
5-1 to 5.6. The semi-major axis, is increasing approximately linearly 
with time. This shows that the averaged radius of the orbit is in- 
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creasing. The equinoctial elements h and k vary sinusuidally with 
an increasing amplitude. This increasing of amplitude showed that 
the averaged eccentricity of the orbit is increasing* The equinoc*- 
tial element is increasing monotonically from 0 radians to 
(2 tt + 5-073) radians- This variation showed how the angular posi- 
tion of the SEPS Spacecraft in the orbit is changed by the engine 
thrust acceleration. Finally the variations of the equinoctial 
elements p and q showed that the inclination of the orbit is de- 
creasing monotonically- 

The values of the input vari^les used in this simulation are 
sximittarized as follows. The statistics of the initial state are 


x(0) 


0-1085 X lO’er 
0-0 


0.0 

0.0 

-0.249 


0-0 


(5.A.1) 



“0.196xl0"^er^ 

0,0 

0.169xl0"^er 

0.0 er 

-0.153xl0"^^er 


0.0 er 

0.139x10'“^ 

0.0 

0.143x10"^ 

o 

• 

o 

m(0).= 

0.169xl0"^er 

0.0 

0.150x10"^ 

0.0 

-5 

-0.414x10"^^ 


0.0 er 

0.143x10 ^ 

O 

o 

0.154x10 

0.0 


-0.153xl0"^^er 

o 

o 

-0.414x10"^^ 

o 

ft 

o 

0.6102x10“^ 


_0.0 er 

-0.161x10'^^ 

o 

o 

0.480x10 ^ 

o 

o 


0.0 

-0.161x10"^^ 

0.0 

0.480x10“^ 

0.0 

0.103x10“^ _ 
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where er is earth-radii 

er = 0.20925696 x 10® feet (5. A. 3) 

The vector xCO) is equivalent to a circular orbit with a radius of 
4300 miles and an inclination of 28 degrees. The matrix m(0) is 
equivalent to the following standard deviations 


(a )_ = 1 mile (5. A- 4) 

r 1 

(a ) « = 5 miles (5 -A. 5) 

r 2 

(a 1 mile {5. A. 6) 

r 3 

= 5 feet/second (5. A. 7) 

(a ) , - 15 feet/second (5* A. 8) 

(o ) ^ - 15 feet/second (5 -A. 9) 

V 


where ^^r^2^ ^*^r ^ 3 ^ ^^v ^ 1 ^ the standard' 

deviations of position and velocity in altitude, down range and 
cross track directions respectively. These statistics are typical 
of a spacecraft launch trajectory. The nominal final time is 


= 22.64 hours 


(5. A, 10) 


The parameters defining the target set are 

" 0.1329xl0*er“ 
0.2670x10"^ 

0.3221x10"^ 

~f ^ 1 

^ 0.5073x10-^ 

-0.2325 

_0. 2068x10"® _ 


(5. A. 11) 
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( 6 Xf)j^ = 0.775 

xlO ^er 

{5. A. 12) 

( 6 x ^)2 = 0.858 

Xl0“^ 

(5. A. 13) 

( 6 x ^)3 = 0.971 

xl0~^ 

(5. A, 14) 

( 6 x ^)5 = 0.594 

xl0“^ 

(5. A. 15) 

(«x^)g = 0,106 

xl0~^ 

(5.A.16) 


The values of the parameters 6 x^ defined the size of the target 
set. Since it is expected that the deviation between the true and 
nominal state at the nominal final time will not be less than the 
expected estimation error ^ the values (5x^ in (5^ A. 12) to (5. A. 16) 
are taken from the standard deviations of the corresponding diagon- 
al elements of the estimation error covariance matrix P (t^) - Note 
that the covariance matrix P(t^) is computed along the minimum time 
nominal trajectory which is not the same as the covariance matrix 
Pi<tf) computed using the equations of the extended Kalman filter. 
The thrust acceleration function is 


u^(t) = 




m 


(l“^t) 

s 


(5. A. 17) 


where is the surface gravity acceleration, is the engine 
specific impulse and e is the engine’s initial thrust acceleration 
in terms of the 90 

G = 0.1 xlO"'^ (5.A.18) 

0.4 xlO^ sec (5. A. 19) 

32.0 feet /second^ (5. A. 20) 


The parameters which represent the strength of the process noise are 


= 0.1 xlO 
N, = 0.42 xlO 


(5. A. 21) 
{5. A. 22) 
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The value of the paroraeter in (5. A. 21) is equal to the square 
of 1 percent and the value of the parameter (5.A-22) is equal 

to 1/2 of the square of 1/60 degree* A set of measurements is 
taken every half orbital period. Each set of measurements consist 
of one earth-diameter and two star-elevation measurements. The 
parameter which represents the strength of the measurement noise is 

0.84xl0~^ 0 0 

= 0 0.84x10"^ 0 

_ 0 0 0.84x10 



Note that (0.84x10"*^) is equal to the square of 1/60 degrees . 

The results of this simulation are pictured in Figures 5.7 to 
5.12 where the difference between the true state and nominal state, 
" the difference between the true state and the estimated state as 



(5.A.24) 


(5. A. 25) 
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(erxj 


- (a) 


nominal 




true" estimated ^ 


t ( hours f 
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Figure 5 ^ 7 




h xlO 



t (hours) 

I true^ nominal I ^ true estimated ^ ^ 

Figure 5,8 
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Figu:. e 5.9 
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Figure 5.10 
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Figure 5.11 
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Q xlO 
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Figure 5^12 
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The corresponding results in terms of the classical orbit elements 
are 


a(t j) 

true 

nominal 

0.9232xl0"^er 

(5.A.26) 

e(tf) 

true 

^ nominal 

0.1824x10“'* 

(5. A. 27) 

i(t^) 

true 

^ ^.^f^ nominal ^ 

0.4009x10"'* 

(5. A. 28) 


true 

Mq (t^) nominal” 

0.8887x10"^ 

(5. A. 29) 

w(t^) 

true 

w(t^) nominal ” 

0.1974x10“^ 

(5. A. 30) 

S) (t^) 

true 

^ nominal ” 

0.2959x10"^ 

(5. A. 31) 

^^^f^true 

estimated 

0.1796xl0"^er 

(5.A.32) 

e(t^)^rue 

® estimated 

0.1397x10“^ 

{5. A. 33) 

^<Vtrue - 

i(t^) ^ ^ ^--0.7390x10“^ 

' f estimated 

(5.A.34) 

^o/^f^true 

^0 ^^f ^estimated'* 

0.3179x10"'^ 

(5. A. 35) 

“^^f>true - 

^^^f^ estimated 

0.1651x10"^ 

(5.A.36) 


^ ^ estimated 

-0.4904x10"^ 

(5.A.37) 


5 >3 Discussion 

The results showed that the SEPS Spacecraft was flying in a 
neighboring trajectory and reached a point close to the desired 
target set at the nominal final time t^« Due to the presence of the 
uncertainties , the deviation between the true and nominal trajectory 
is not small throughout the flight except at time t^. At time t^ , 
the deviation between the true and the nominal state is small. A 
comparison of (5. A. 12) to (5 -A. 16) and (5. A. 24) showed that the 
closed-loop system is performing reasonably well for this short mis- 
Sion. The vnluns of - » <‘f > „ominall ' I''* V '*f ’ 

nail “O IP"^fltfnn ‘ P<‘£>nominall ““ 

(5Xf)2^ (<5x^)^ respectively. The value of l^^^f^true 

- ^ approximately 1.19 times the value of 


72 



The value of ^ nominal ^ approxiamtely 64.94 times 

the value of This large ratio is due to the fact that ^ 

is very small and the actual estimation error I true ^ ^^^f^ esti- 
mated^ is approxiamately 10.6 times the value of (6x^)g. However^ 
since the equinoctial elements p and q should have the same charac- 
ter, a comparison of the values of - P nominal ^ 

I'^^^f^true " ^^^f^nominal^ (5. A. 24) showed that the closed-loop 

system is still performing reasonably well. The value of | ^^o^true 

- (x.) . I is not small for this midcourse flight since this 

0^ nominal ‘ 

equinoctial element is not included in the exponential-^ cost criterion. 

The deviation between the true and estimated state is also pre- 
sented in Figures 5.7 to 5.12. Between two measurements the estima- 
tion errors are approximately constant- At a measurement the esti- 
mation errors have discontinuities. These estimation errors tend 
to increase slowly with time. This indicated that for a longer mis- 
sion some more accurate measurements such as ground based tracking 
must be used to reduce these estimation errors. At these high ac- 
curacy ground based measurements , the minimum time nominal trajectory, 
the feedback control gain matrix A(tj) and the vector b(tj) could 
also be updated. If these ground based updates are included in the 
miscourse guidance and navigation of the SEPS Spacecraft, the closed- 
loop system developed in this research should also perform well for 
a longer mission. 

The most important advantage of using the LEG guidance law in 
the closed-loop system is that the weighting matrices and can 
be chosen to achieve desired system performance. This fact is indi- 
cated by the simulation results. In the linear-quadratic-gauss ian 
(LQG) problem [Ij , these weighting matrices usually must be obtained 
by iterations to achieve the desired system performance. 
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CHAPTER VI 


CONCLUSIONS 

A practical and efficient midcourse guidance and navigation sys 
system for the SEPS Spacecraft has been developed in this research- 
To reach the target set in minimum time the SEPS Spacecraft always 
utilizes full thrust magnitude. The thrusting direction of the en- 
gine is determined by the solution of the LEG terminal cost problem. 
The LEG approach provides a systematic way of determining weighting 
matrices for problems involving bounds and the control system design 
did not require many iterations, as is typically the case when the 
LQG approach is used. The solution of this problem, which is the 
guidance law, determines the control as a linear function of the 
current state estimate. Using this guidance law, the' SEPS Space- 
craft will fly in trajectory neighbouring the minimum time traject- 
ory. To take into account this fact, the extended Kalman filter is 
used for the navigation of the SEPS Spacecraft. 

The simulation results of a short mission have indicated that 
this closed-loop system is very efficient in bring the SEPS Space- 
craft to the target set. However, these. results have also indicated 
that the state estimation errors tend to increase slowly with time. 
For a long mission this means that the navigation system would have 
very poor state estimation and consequently the closed-loop system 
would have very poor performance. Therefore it is concluded that if 
this system is to be used effectively for a long mission, some more 
accurate ground based measurements and nominal trajectory updates 
must be included in the guidance and navigation of the SEPS Space- 
craft. 
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The determination of an efficient measurement schedule, the fre- 
quency of high accuracy ground based measurement and nominal tra- 
jectory updates can be carried for further study to improve the 
effectiveness and performance of this closed-loop system. The pos- 
sibilities of using this closed- loop system for terminal guidance and 
navigation of the SEPS can also be investigated* 


76 



APPENDIX A 


ax 

THE MATRIX 


ax 


The 


matrix - r — is given by 
0 r 


ax 

ar 


.T ax 


T ^ T 


- .aa-" ah*^ ak“" ap^ aq-", 

7 = ^ Jt ^ ^ ^ 


where 


r 

“ 


„,T y, u2 , 2 ax, 3 

- - f \ ^ - 

ma r r 


ar 


k ( qY ^- pX ^) ^ 


/, ^ 2.2 ax 3 3 Y- 3 

II .'^1^ Ujji - ke. ^ Xj)l * (jjl - kBm Sj V 
— ma r r 


h (qYj^-pXj) 


ma 


2/l-h2-k2 


aX/v T ox. /i 1 ^ ax-i c/^-i 

0 1 , 3yt . /1-h -k o r /u 1 j. V i 

= 2-(v - r ) - ^ et(h ^ + k 

— ma r ma 


axj 

3k 


3Y 


3 V , 




( qY ^- pX ^) 


W 


2 /, ,. 2,2 

ma /1-h -k 


(A-1) 

(A- 2) 
3 

(A-3) 

i)g] 

(A-4) 

)f 

(A-5) 
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(A-6> 



2 2 

_ +3 y, w 

■> — 





(A-7) 


3X, 

~ 

(A-8) 



3X, 

3v '“‘’f 
^3lc^ “ 

(A-9) 

W ^ 


^ " 

T 

i 

(A-10) 

3k 

3v^ 
(— ) g 

3k ~ 

(A- 11) 


3v 9v 

The partial deriviatives ^ ^ are presented in Appendix C 
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APPENDIX B 


THE MATRIX 
8r 

The matrix ^ is given by 

3r 3r 3r 3r 3r 3r 3r 

3x " ^ 3a 3H aic 3 Xq 3p 3g ^ 


where 


Fa 




3r ax, 3Y, 

FH = 3h- i + FH~ i 

3r 3X, 3Y, 

FJ? " FIT" - £ 


9r V 





l+p^+g^ 


tq(Xll 


Xig) -X^wJ 


3r 

Fq 


5 ^ [p(x g - Y f) + Y w ] 

1+P +q 


(B-l) 

<B-2) 

(B-3) 

(B-4) 

(B.5_ 

(B.6) 

(B,7) 
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APPENDIX C 


THE MATRIX ^ 


a V 

The matrix ^ is given by 

0 X 


av 3v 3v 9v 3v 3v 3v 
^0 


3x ■ ^3a ^ 3lc 3Xn 3p 3q^ 


(C-1) 


where 


3v 

3a 




(C-2) 


3v 3X. 3Y, 

^ = 5TT ^ ^ 


(C-3) 


3v 3X, 


3Y, 


'1 “"I 

3i? = ^ ^ 3ir i 


(C-4) 


— = -rci — :t r 
3X0 r*^ 


(C-5) 


3v 


^ - *1 ^ ' 


(C-6) 


l+p q 


(C-7) 


3X 2 2^ 

^ ^ f ~ ^ P(X-F) + hB sin F + I cos^ F] 


^ (I 'cos F (X-F) - sin F] 


(C-8) 








di 







9X 2 3 

i. = (1-—) + sin P (X-F) + cos F (hfi— ^ sin F) ] 

3k r ‘1-6 ' a' r r 

aX- ^ 

+ — =■ [- sin P (X-F) + cos F] (C-9) 

r r 

3 Y 2 3 

[WS|_(£ - 1) + cos F (X-F) - Sin F (kB - cos F) ) 

- [— cos P (X-P) - sin Fl (C-10) 

r r 


3Xl 

w~ 


X 


3 2 3 

4 *^) (| - 1) - sin F(X*-F) “ k3 cosF - | sin^P] 

aYi 

+ sin F(X-F) + cos F] (C-11) 

Xq + mt (C-12) 
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APPENDIX D 


THE MATRIX A(Xq, Uq , t) 


The matrix A(x^, Uq, t)is given by 


A{Xq, Uq, t) G(x,t)ul^^^^^ 



3 ,3a . . 
aF^lv 


3 f9a . 
^ ^ - 

y'4 
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^ uV 
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u) 

3a ^3v 

u) 

3h^3v 

3k H> 

3 ,3h \ 

Ip'^Sv 
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•§h^3^H.) 


5TJ*5^’ 

3 ^^0 

3 9Xq 


^(1E u) 
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(D-1) 
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(D-2) 
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COS r(l + k sin F - h cos P) 


+ a sin F 


2 

3 Y, 


3r3h 


a^y-, ■ 


akah 


^ = a - (2k sin F - h cos F) + p p cos F 


a ke^ ®^^1 


a^Y, 


h cos F) - a cos F 
2 


arah 


^ sin P(1 + J 
r 


2 2 
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d^dn [ ( 1 - 3 ) 


2 

9r^ 


cos F(k3 - cos F) 


(D-53) 

: sin F 
(D-54) 
(D-55) 

(D-56) 

*1 

(D-57) 

(D-58) 
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+ — cos F (cos F - kB) 


I 
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3 3 y^^ 
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(D-60) 
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- ? P] I ^ ^ ^ ^ 
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2 
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(D- 61 ) 


3^y, 


3 2 
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(D-66) 


(D-67) 


(P-68) 
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(D-70) 


(D-71) 


(D-72) 
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3Yj^ 3r 
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T 
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